Wheel calibration
✎🔗Andrea Daniele
You can run the joystick demo remotely. The procedure is documented in Unit C-11 - RC control launched remotely.
Calibrate the wheels of the Duckiebot such that it goes in a straight line when you command it to. Set the maximum speed of the Duckiebot.
Introduction
✎The motors used on the Duckiebots are called “Voltage-controlled motors”. This means that the velocity of each motor is directly proportional to the voltage it is subject to. Even though we use the same model of motor for left and right wheel, they are not exactly the same. In particular, every motor responds to a given voltage signal in a slightly different way. Similarly, the wheels that we are using look “identical”, but they might be slightly different.
If you drive the Duckiebot around using the joystick, you might notice that it doesn’t really go in a straight line when you command it to. This is due to those small differences between the motors and the wheels explained above. Different motors can cause the left wheel and right wheel to travel at different speed even though the motors received the same command signal. Similarly, different wheels travel different distances even though the motors made the same rotation.
What is the Calibration step?
✎We can counter this behavior by calibrating the wheels. A calibrated Duckiebot sends two different signals to left and right motor such that the robot moves in a straight line when you command it to.
The relationship between the velocities and the voltages of left and right motors are:
\begin{align*} V_{\text{right}} &= (g + r) * (v + \dfrac{1}{2} \omega l ) \\ V_{\text{left}} &= (g - r) * (v - \dfrac{1}{2} \omega l ) \end{align*}
where $V_{\text{right}}$ and $V_{\text{left}}$ are the voltages for the two motors, $g$ is called gain, $r$ is called trim, $v$ and $\omega$ are the desired linear and the angular velocity of the robot, and $l$ is the distance between the two wheels. The gain parameter $g$ controls the maximum speed of the robot. With $g \gt{} 1.0$, the vehicle goes faster given the same velocity command, and for $g \lt{} 1.0$ it goes slower. The trim parameter $r$ controls the balance between the two motors. With $r \gt{} 0$, the right wheel will turn slightly more than the left wheel given the same velocity command; with $r \lt{} 0$, the left wheel will turn slightly more the right wheel.
Perform the Calibration
✎Calibrating the trim parameter
✎
The trim parameter is set to $0.00$ by default, under the assumption that both motors and wheels are perfectly identical. You can change the value of the trim parameter by running the command:
duckiebot $ rosservice call /robot name/inverse_kinematics_node/set_trim -- trim value
Calibrate the trim parameter using the following steps.
Step 1
✎Make sure that your Duckiebot is ON and connected to the network.
Step 2
✎On your Duckiebot, launch the joystick process:
duckiebot $ roslaunch duckietown joystick.launch veh:=robot name
Step 3
✎Use some tape to create a straight line on the floor (Figure 14.1).
Step 4
✎Place your Duckiebot on one end of the tape. Make sure that the Duckiebot is perfectly centered with respect to the line.
Step 5
✎Command your Duckiebot to go straight for about 2 meters. Observe the Duckiebot from the point where it started moving and annotate on which side of the tape the Duckiebot drifted (Figure 14.2).
Step 6
✎Measure the distance between the center of the tape and the center of the axle of the Duckiebot after it traveled for about 2 meters (Figure 14.3).
Make sure that the ruler is orthogonal to the tape.
If the Duckiebot drifted by less than $10$ centimeters you can stop calibrating the trim parameter. A drift of $10$ centimeters in a $2$ meters run is good enough for Duckietown. If the Duckiebot drifted by more than $10$ centimeters, continue with the next step.
Step 7
✎If the Duckiebot drifted to the left side of the tape, decrease the value of $r$, by running, for example:
duckiebot $ rosservice call /robot name/inverse_kinematics_node/set_trim -- -0.1
Step 8
✎If the Duckiebot drifted to the right side of the tape, increase the value of $r$, by running, for example:
duckiebot $ rosservice call /robot name/inverse_kinematics_node/set_trim -- 0.1
Step 9
✎Repeat the steps 4-8.
Calibrating the gain parameter
✎
The gain parameter is set to $1.00$ by default. You can change its value by running the command:
duckiebot $ rosservice call /robot name/inverse_kinematics_node/set_gain -- gain value
Test the Duckiebot for different values of the gain parameter.
doubt
@liampaull What is the correct value to use for the gain? -AC
Store the calibration
✎When you are all done, save the parameters by running:
duckiebot $ rosservice call /robot name/inverse_kinematics_node/save_calibration
The first time you save the parameters, this command will create the file
src/00-infrastructure/duckietown/config/baseline/calibration/kinematics/robot name.yaml
You can add and commit it to the repository.
we are in the process of rewriting the configuration system, so in a while “commit to the repository” is not going to be the right thing to do.
comment
It might be helpful to talk about the ROS Parameter Server here, or at least reference another page. -AD